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1 .  INTRODUCTION 

1.1  The  Autopilot  Design  Problem 

The  design  of  an  autopilot  to  control  a  short  range  air-to-air  weapon 
is  a  complex  process  due  to  the  nature  of  the  plant,  the  control  mechanism, 
and  the  available  measurements.  The  plant  can  be  considered  to  be  the 
vehicle  itself  with  its  associated  aerodynamic  and  inertial  properties  and 
the  rocket  motor.  The  control  mechanism,  an  actuation  system  for 
controlling  movable  tail  surfaces,  is  also  considered  part  of  the  plant. 

The  measurement  devices  are  assumed  to  be  three  angular  rate  and  three 
translational  acceleration  devices.  The  difficulty  in  controlling  the 
plant  can  be  summarized  in  terms  of  the  following  seven  factors: 


(i)  The  plant  is  time -varying .  The  rotational  and  translational  motion 
of  the  vehicle  can  be  described  in  terms  of  a  set  of  noni-iear  differential 
equations  with  time  variable  coefficients.  These  equations  can  be 
linearized  about  an  operating  point,  but  this  operating  point  will  vary 
with  time.  The  aerodynamic  forces  and  moments  are  functions  of  speed  (V), 
angle-of-attack  (a)  and  side-slip  (0),  fin  deflections  (6),  dynamic 
pressure  (qg) ,  and  body  angular  rates  (p,q,r).  Of  these,  only  fin  deflec¬ 
tion  and  the  rates  are  available  directly  from  measurement.  The  other 
quantities  are  unmeasured  states  of  the  system  (e.g,  V,  a,  b  or  equiva¬ 
lently  Vx,  V y,  Vz  in  body  coordinates)  or  functions  of  the  states 
(e.g.,  qo  ■  l/2p(h)  V^,  where  h  »  altitude).  Clearly  the  estimation  of  the 
system  states  is  advantageous  in  developing  a  control  strategy.  Knowledge 
of  the  system  states  will  aid  in  the  estimation  of  other  system  parameters. 
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most  notably  the  aerodynamic  coefficients.  Another  time  variable  aspect  of 
the  plant  is  the  inertial  properties.  As  the  rocket  motor  burns,  there  are 
variations  in  mass,  c.g.  locations,  and  moments  of  inertia. 

(ii)  The  plant  is  nonlinear  in  the  sense  that  the  forces  and  moments 
are  nonlinear  functions  of  the  system  states.  For  example,  the  dynamic 
pressure  is  proportional  to  the  square  of  the  velocity.  A  more  troublesome 
nonlinearity  for  the  autopilot  designer  is  the  nonlinear  nature  of  the  aero¬ 
dynamics.  The  aerodynamic  moment  coefficients  and  Cn  are  in  general, 
functions  of  a  and  8,  Mach  number  (Mn)  and  fin  deflection  (6).  Variations 
with  angle-of -attack,  e.g.  8(^/8 a,  affect  the  airframe  stability.  If  this 
slope  is  negative,  the  open  loop  airframe  tends  to  be  stable.  Otherwise, 
the  transform  function  will  have  poles  in  the  right  half-plane.  The  nonli¬ 
near  nature  of  the  C^,  curve  is  shown  by  the  example  in  Figure  1.1.  Notice 
that  at  low  angles-of -attack  the  vehicle  is  stable  but  becomes  unstable 
between  5  and  10  degrees.  Then  it  becomes  stable  again  above  15  degrees. 

(iii)  The  plant  is  uncertain.  In  particular,  several  aerodynamic  para¬ 
meters  such  as  moment  coefficients,  dynamic  derivatives,  nonlinear  deriva¬ 
tives  based  on  wind-tunnel  and  aero  prediction  methods  do  not  have  high 
accuracy.  The  estimates  of  these  coefficients  can  be  improved  using  pre¬ 
vious  flight  test  data,  but  a  certain  amount  of  uncertainty  will  always  be 
present  in  the  parameter  estimates.  This  requires  use  of  either  robust 
control  design  which  can  accommodate  parameter  uncertainties  or  adaptive 
control  design  which  reduces  uncertainties  using  on-line  parameter 
estimation. 
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(lv)  The  plant  has  coupled  inputs  and  outputs.  Equivalently,  the  three 
autopilot  channels  (roll,  pitch  and  yaw)  or  axes  of  motion  are  coupled.  The 
coupling  cooes  about  through  kinematic,  aerodynamics,  e.g.,  C^gCHn.a), 
bank-to-turn  guidance  law  and  actuator.  In  classical  design,  this  coupling 
is  ignored. 

(v)  The  plant  can  be  unstable.  As  discussed  under  the  nonlinear  nature 
of  the  aerodynamics,  the  vehicle  may  be  stable  or  unstable,  depending  on 
the  operating  point.  The  stability  of  the  plant  affects  the  type  of 
control  strategy,  the  need  for  robustness  in  that  strategy,  and  the 
required  accuracy  of  the  estimation.  In  addition  to  the  possible  unstable 
poles  due  to  C^,  tail  control  yields  non-minimum  phase  zeros  in  the 
aerodynamic  transfer  function  due  to  the  force  on  the  tail,  i.e.,  C^. 

This  can  be  particularly  troublesome  when  using  classical  design  tech¬ 
niques,  especially  at  low  dynamic  pressure  flight  conditions. 

(vi)  The  system  constraints  are  significant.  These  constraints  include 
the  finite  bandwidth,  slew  rate,  deflection  and  torque  of  the  actuator  and 
the  quality  of  the  measurements  available  from  the  sensors.  For  the  sen¬ 
sors  to  be  reasonable  in  cost,  the  quality  of  the  output  in  terms  of  range, 
scale  factor  errors,  and  noise  will  be  limited.  The  quality  of  the 
measurements  directly  affects  the  accuracy  of  the  state  and  parameter  esti¬ 


mates  . 
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Figure  l.l  Nonlinear  Sac  ire  of  Airframe  Aerodynamics 

(vii)  The  design  requirements  are  severe.  Due  to  the  short  flight 
times  invoived  with  the  short  range  air-to-air  mission,  the  required  -capo 
system  bandwidths  are  high.  These  short  flight  times,  coupled  witn  nigh!.- 
maneuverable  targets,  yield  requirements  for  high  missile  accelerations  i 
angles-of-attack.  These  high  a’s  aggravate  the  problem  of  nonlinear  ic :  - 
dynamics  and  coupling. 

In  summary,  the  autopilot  design  problem  can  be  expressed  as  a  proa*-.- 
of  state  and  parameter  estimation,  as  well  as  the  design  or  tne  contra* 
system  for  a  nonlinear  coupled  mulivariabie  system  with  constraints. 

1.2  Bank-to-Turn  Steering 

Current  missiles  using  skid-to-turn  (STT)  steering  have  performance 
limitations;  for  example,  angle  of  attack  and  turn  maneuverability  arc 
restricted  as  a  result  of  yaw/ roll  cross  coupling  which  tends  to  rot  it-  \ 
airframe  away  from  the  desired  maneuver  plane.  These  undesirable  tor 
increase  with  angle  of  attack  and  may  exceed  tne  trim  capability  (Trans.-, 


V.v,  V.  V  >  o 
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1985).  Large  angles  of  attack  in  STT  missiles  can  result  in  large  sideslip 
angles  which  in  turn  cause  large  vortex  wake  asymmetries.  These  large  wake 
asymmetries  can  result  in  unwanted  roll  and  yaw  moments  which  may  be  large 
enough  to  exceed  the  trim  capability  of  the  control  system. 

S 

In  order  to  alleviate  these  undersirable  effects,  bank-to-turn  (BTT) 
steering  has  been  developed  and  has  recently  received  much  attention.  In 
this  type  of  steering,  the  control  system  continuously  banks  the  missile  so 
as  to  minimize  the  angle  of  sideslip  and,  hence,  the  asymmetry  of  its  vor¬ 
tex  wake.  The  resi  it  of  this  is  that  the  missile  can  be  maneuvered  at 
higher  angles  of  attack,  increasing  its  lift  capability  (see,  e.g.  Froning, 
1985).  BTT  designs  can  reduce  weight  and  drag  while  maintaining  high 
maneuverability.  Even  though  BTT  steering  appears  desirable  from  these 
aspects,  there  are  currently  no  high  performance  antiair  missiles  within 
the  U.S.  arsenal  using  this  technology  (Arrow,  1985).  Flight  tests  and 
detailed  simulation  results  on  BTT  steering  have  not  achieved  total 
response  times  currently  available  with  existing  STT  configurations.  The 
most  significant  characteristic  which  impacts  the  achievable  response  time 
is  the  dynamic  coupling  primarily  due  to  nonzero  missile  body  rates  and 
accelerations  (Arrow,  1985).  A  number  of  BTT  configurations  have  been 
developed.  Perhaps  the  most  challenging  one  from  a  control  point  of  view 
is  the  monoplanar  single  inlet  configuration  in  which  angle  of  attack  is 
restricted  to  a  small  negative  number  or  a  large  positive  number.  In  this 
configuration,  very  large  lift  forces  can  be  attained.  However,  Che  rolL 
angle  may  have  to  be  changed  180°  in  response  to  a  command  from  the 


guidance  system. 
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Current  autopilot  designs  for  BTT  steering  typically  utilize  linear  or 
linearized  control  design  techniques.  Williams,  et  al  (1985)  countered  the 
effects  of  nonlinearities  by  freezing  roll  rates  and  using  a  linear- 
quadratic-gaussian  design  methodology  at  each  fixed  roll  rate.  By 
including  actuator  dynamics,  the  resulting  state  vector  dimension  was  10 
for  the  pitch/yaw  channel  and  2  for  the  roll  channel.  Coupling  from 
pitch/yaw  to  roll  was  treated  as  a  disturbance  term  in  the  roll  dynamics. 
Hardy  (1985)  performed  an  autopilot  design  for  a  BTT  missile  using  pole 
assignment.  The  equations  of  motion  were  linearized,  resulting  in  a  fourth 
order  pitch  axis  model  and  an  eighth  order  roll/yaw  axis  model.  Dixon  and 
Klabunde  (1985)  used  linear  design  methods  to  develop  a  lateral  autopilot 
using  gains  scheduled  as  a  function  of  angle  of  attack.  Chung  and  Shapiro 
(1982)  used  a  linear  modal  synthesis  approach. 

Another  example  of  the  classical  approach  is  the  design  study  by 
Rockwell  under  Eglin  AFB  sponsored  "Interlaboratory  Air-to-Air  Technology" 

( ILAAT) .  These  included  analytical  studies  with  two  different  airframes 
(Eminert  et.  (1976,  1978).  The  initial  studies,  dating  from  1976,  employed 
a  dither  adaptive  approach  for  state  /  parameter  identification.  By 
dithering  the  airframe  in  yaw  at  a  frequency  in  the  range  of  10-13  Hz,  an 
estimate  of  dynamic  pressure  was  generated.  This  estimate  was  used  to 
schedule  the  gains  of  the  pitch  and  roll  rate  loops  to  maintain  the  desired 
bandwidth,  independent  of  flight  condition.  This  was  successful,  because 
the  gain  of  the  aerodynamic  transfer  function  (r/3r)  is  roughly  propor¬ 
tional  to  qg.  The  acceleration  loops  were  also  scheduled  as  a  function  of 
qg,  although  the  aerodynamic  gain  was  proportional  to  speed  (V)  rather 
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chan  V^.  Scheduled  Limits  on  commanded  acceleration  were  used  to  limit 
angles-of-attack  and  side-slip.  The  dither  adaptive  approach  had  the 
advantage  of  requiring  no  interface  with  the  launch  aircraft  and  only  two 
accelerometers. 


* 

t 

[ 


t 
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In  a  later  design,  (Emmert  et.al.  ( L 9 7 8) )  the  dither  adaptive  approach 
was  again  employed,  but  a  velocity  estimate  was  generated  based  on  an  added 
axial  accelerometer.  A  rough  estimate  of  a  and  &  was  also  developed.  The 
velocity  estimate  assured  closer  control  of  acceleration  loop  bandwidth  and 
a  more  linear  acceleration  loop  gain  schedule.  However,  the  dither  adap¬ 
tive  design  has  a  number  of  shortcomings  which  can  be  overcome  with  modern 
control  approaches.  First,  Che  bandwidth  of  the  system  is  limited  by 
system  nonlinearities  and  non-minimum  phase  zeros  of  the  aerodynamic 
transfer  function,  particularly  at  low  dynamic  pressures.  The  zeros  are 
also  functions  of  flight  condition,  thrust  level  and  c.g.  location  and  can 
vary  by  a  factor  of  10  in  frequency.  Secondly,  a  significant  amount  of 
yaw/roll  coupling  exists  in  spite  of  a  high  bandwidth  roil  rate  loop.  It 
is  desirable  to  lower  the  rate  loop  bandwidtns  which  affect  actuator 
requirements,  while  minimizing  coupling  between  channels.  This  cannot  be 
achieved  effectively  with  classical  control  design  which  relies  on  high 
gains  to  produce  decoupling.  Reduced  rate  loop  bandwidths  will  also  alle¬ 
viate  the  computational  burden  on  the  digital  processor.  Thirdly,  it  is 
desirable  to  improve  the  robustness  of  the  autopilot  and  provide  some 
degree  of  fault  tolerance. 

Several  authors  have  utilized  nonlinear  transformations  in  flight 
control  and  attitude  control  systems.  Meyer,  Su  and  Hunt  (1984)  found  that 
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a  nonlinear  helicoptor  model  could  be  linearized  via  a  nonlinear  transfor- 
macion,  since  it  was  in  the  class  of  equivalent  linear  systems  (Su,  1982)  . 
Dwyer  (1984)  derived  linearizing  transformations  for  the  rigid  body  atti¬ 
tude  control  problem  and  solved  several  particular  cases  ( rest-to-rest  and 
detumbling)  using  linear  quadratic  control  theory.  One  problem  with  these 
approaches  is  that  control  and  state  constraints  become  generally  more 
complex  in  form  and  are  not  easily  handled.  Thus,  if  constraints  are  taken 
into  account,  these  methods  tend  to  conserve  complexity. 


M 


1 


Decoupling  is  another  technique  which  leads  to  nonlinear  controls.  In 
BTT  steering,  the  kinematic  and  inertial  coupling  of  the  roll  and  yaw 
systems  during  combined  pitch  and  roll  maneuvers  is  significant.  The 
problem  is  to  maintain  a  small  sideslip  angle,  and  one  way  to  accomplish 
this  is  to  use  cross-feed  signals  between  the  axes  to  decouple  the  yaw  and 
roll  control  axes.  Froning  and  Gieseking  (L973)  used  decoupling  for  a 
linear  BTT  model.  Reed,  et  al,  (1985)  developed  a  noninteracting 
controller  for  a  BTT  missile  which  decoupled  the  roll,  pitch  and  yaw  axes 
and  used  simulations  to  study  the  performance.  Their  feedback  law  was 
based  on  a  quadratic  performance  index.  Unfortunately,  decoupling  also 
tends  to  conserve  complexity. 


*  i 


Solution  of  the  general  optimal  control  problem  in  missile  autopilot 
design  seems  intractable.  The  inclusion  of  Euler  angles  to  include  body- 
fixed  constraints  in  an  inertial  formulation  generates  a  tire-varying, 
nonlinear  two-point-boundary-value  problem  which  appears  to  make  a  real¬ 
time  solution  impossible  with  current  computer  technology  (Gupca,  et  al, 
1981)  . 
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1 . 3  Nonlinear  Control  Decoupling  via  Feedback 

The  missile  dynamics  are  nonlinear  and  it  is  very  desirable  to  consider 
control  designs  that  apply  to  nonlinear  problems.  Pointwise  linearization 
followed  by  gain  scheduling  is  the  most  common  technique  for  controlling 
nonlinear  systems,  but  it  is  not  very  effective  for  highly  maneuverable 
systems  which  rarely  operate  around  a  steady  state  condition.  One  of  the 
most  promising  techniques  for  nonlinear  control  design  is  based  on  the  use 
of  nonlinear  feedback  in  such  a  way  that  the  closed  loop  system  has  the 
desired  behavior.  For  missile  autopilot  design  one  would  like  to  achieve 
fast  decoupled  response  between  guidance  commands  and  acceleration  outputs 
so  that  the  autopilot  would  follow  the  guidance  commands  accurately. 

Notice  that  with  3  control  inputs,  one  can  decouple  only  3  output  channels. 
The  most  appropriate  ones  for  missile  autopilot  design  will  be  angle  of 
attack  and  sideslip  (a,  d)  and  roll  ($>),  which  are  closely  related  to  piteu 
and  yaw  accelerations  for  a  BTT  missile. 

The  problem  of  control  decoupling  via  feedback  together  with  the  clo¬ 
sely  related  problems  of  disturbance  decoupling  and  invariance  has  arisen 
in  many  engineering  applications,  including  missile  and  aircraft  control 
problems.  Since  Rozenoer's  (1963)  initial  work,  the  subject  of  control 
decoupling  via  feedback  has  been  extensively  developed,  and  a  reasonably 
large  body  of  literature  currently  exists.  Some  papers  which  have  been 
important  milestones  are  Wonhara  and  Morse  (1970),  Tokamaru  and  Iwai  (1971), 
Majumdar  and  Chaudhury  (1972),  and  Isidori  et  al.  (1981).  In  addition  t) 
this  theoretical  work,  several  applications  to  problems  of  aircraft  contr;. 
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have  been  studied  including  Singh  and  Schy  (1978)  and  work  by  G.  Meyer 
(1981)  on  the  design  of  an  autopilot  system  for  the  Bell  UH-1H  helicopter. 

The  basic  idea  behind  the  theory  of  control  decoupling  is  quite  simple: 
Suppose  there  is  given  a  nonlinear  control  system  of  the  form 


x  *  f(x)  +  u^  g^(x)  +  u2  g2(x) 


yi  -  hi(x) 


(i-1,2) 


We  wish  to  consider  modifications  of  the  system  dynamics  using  feedback 
controls  u  -  a(x)  +  B(x)v  such  that 


x  -  f(x)  +  v ^  g^x)  +  v 2  g2(x) 


yi  -  hf_(x) 


(i-1,2) 


(1.1) 


(1.2) 


whe  re 


f  *  f  + . l  a<  g^ 
j*l  J 

2 

gi  “j-i  BJi  gj 

The  decoupling  problem  is  to  find  a  and  B  such  that  v^  controls  yi  and  only 
yi.  (That  is,  we  want  vj  to  have  no  influence  on  the  output  yi  and 
vice-versa) . 


Techniques  for  finding  a  and  B  in  the  case  in  which  f  and  the  h^'s  are 
linear  and  the  gj/s  are  independent  of  x  are  well  known  and  may  be  found  i: 
Wonham  (1970).  For  nonlinear  systems,  considerably  less  is  known  and 
although  the  beginnings  of  the  theory  date  back  to  1962,  many  aspects 


remain  to  be  understood. 
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L.  Rozonoer  (1963)  obtained  conditions  necessary  for  invariance  (i.e. 
independence  of  the  output  upon  the  input)  in  nonlinear  system,  by  using  a 
variational  method  similar  to  the  Pontryagin's  optimality  priciple. 

H.  Tokumaru  and  Z.  Iwai  (1972),  and  A.  Majumdar  and  A.  Chaudry  (1972), 
independently  have  applied  the  variational  method  used  by  Rozonoer  to 
obtain  necessary  conditions  for  non-interacting  control,  for  linear  time- 
variant  systems  (1968)  and  for  nonlinear  systems  (1971).  A  concrete  design 
for  control  decoupling  feedback  for  the  automatic  piloting  of  a  mine  hunter 
boat  was  given  by  E.  Daclin  (198U). 

All  theoretical  work  mentioned  above  neglected  the  existence  of 
constraints  on  controls  in  virtually  every  real-life  situation  (e.g.,  a 
limit  on  control  deflections,  acceleration  rates,  etc).  The  effects  of 
such  contraints  have  been  studied  by  D.  Hanson  and  F.  Stengel  (L981),  par¬ 
ticularly  for  system  with  two  degrees  of  freedom. 


A  different  approach  to  the  problem  was  used  by  R.  Su,  G.  Meyer  and  L. 
Hunt  (1983),  who  used  nonlinear  transformations  to  reduce  the  nonlinear 
problem  to  the  linear  one,  which  can  be  treated  by  standard  methods,  as  in 
Wonham  (1970).  The  main  drawback  here  is  that  it  is  not  generally  possible 
to  carry  out  this  type  of  linearization;  there  are  both  algebraic  and  topo¬ 
logical  obstructions  which  are  essentially  the  same  ones  that  are  encounted 
if  one  were  to  try  to  do  nonlinear  decoupling  directly. 


An  important  application  of  control  decoupling  theory  to  the  problem  of 
aircraft  dynamics  was  given  by  S.  Singh  and  A.  Schy,  (1980).  These  authors 
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derive  a  feedback  for  a  simplified  aircraft  model  in  which  certain  aerody¬ 
namic  forces  had  been  ignored. 


1.4  Summary  of  Report 


In  this  report  we  consider  the  general  problem  of  developing  efficient 
attitude  transfer  maneuvers  in  response  to  guidance  commands,  in  order  to 
meet  desired  translational  accelerations.  Throughout,  we  consider  a  very 
general  missile  configuration  and  develop  techniques  which  should  be  appli¬ 
cable  to  a  wide  class  of  BTT  missiles.  The  problem  formulation  includes 
nonlinearities  which  are  significant  at  high  body  rates  and  at  high  angles 
of  attack.  In  addition,  constraints  on  angle-of-attack,  control  surface 
deflections  and  body  rates  are  included.  Using  several  reasonable  assump¬ 
tions,  we  study  the  problem  analytically  and  develop  several  nonlinear 
control  strategies  using  both  decoupling  control  and  time  optimal  control 
methods.  Decoupling  controllers  are  presented  using  two  control  modes;  (.  I ) 
body  rates  as  controls,  (2)  control  surface  deflections  as  controls.  In 
all  cases,  the  controller  is  nonsingular  if  the  missile  is  not  in  a  stalled 
flight  condition  and  not  on  a  constraint  boundary.  Explicit  conditions  for 
avoidance  of  constraint  boundaries  are  derived,  which  may  be  used  to  sec 
key  autopilot  design  parameters  such  as  time  constants.  The  controllers 
are  shown  to  be  quite  robust  to  estimation  errors.  A  minimum-time 
controller  which  includes  constraints  on  both  controls  and  angle-of-at tack 


is  developed  and  an  example  is  given 
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We  make  several  assumptions  in  order  to  obtain  the  equations  of  motion 


(i)  the  missile  is  a  rigid  body 


(ii)  the  body  axes  are  the  principal  axes  of  inertia 


(iii)  the  principal  moments  Lyy  and  Izz  are  equal 


(iv)  gravitational  acceleration  is  neglected. 


The  assumed  inertial  properties  simplify  the  analysis  in  the  sequel. 
The  design  methodology  holds  for  arbitrary  inertial  properties,  however. 


With  these  assumptions  we  have; 


Translation 


m  (u  +  qw  -  rv)  *  F* 
m  (v  +  ru  -  pw)  »  Fv 


(2.1) 

(2.2) 


ra  (w  +  pv  -  qu)  »  Fz 


(2.3) 


whe  re : 


Fx,  Fy,  Fz  are  the  external  forces,  due  to  thrust  and  aerodynamics 
resolved  into  body  axes 


u,  v,  w  are  the  inertial  velocity  components,  resolved  into  body  axes, 


paQpa.  =~AP  v 
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p,  q,  r  are  Che  body  angular  rates,  in  body  coordinates 
m  is  the  vehicle  mass,  assumed  constant 
u,  v,  w  are  the  time  derivatives  of  u,  v,  w 

Rocation 


L  - 

Ixx 

P 

(2.4) 

M  - 

Iyy 

• 

9  ~  (Iyy  ~  ^xx) 

r  P 

(2.5) 

N  - 

iyy 

r  +  Uyy  ~  Ixx) 

q  p 

(2.6) 

whe  re : 


L,  M,  N  are  the  resultant  moments  about  the  vehicle  center  or  gravity, 
resolved  along  body  axes 

Ixx,  Iyy  are  che  principal  moments  of  inertia  (Ixx  <  Lyy) 


•  •  • 

pf  q,  r  are  Che  time  derivatives  of  p,  q,  r  measured  in  body 
coordinates 

Since  we  will  be  principally  concerned  with  controlling  the  angle  ot 
attack  (a)  and  angle  of  sideslip  (d),  it  is  more  convenient  to  work 
directly  with  them.  Using  the  definitions 


tana  »  w/u 

(2.:; 

tan8  ■  v/u 

(2.8) 

we  get 


a  ■  q  + 


Fzcosa  -  Fxslna 
mV  cosa 


(p  cosi  +  r  sina)  cosa  tana 


f  1 

V.  - 
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ti>  *  -  r  +  FyC0^a  *S—~  +  (p  cost!  +  q  sind)  Cana  cosd  (2.10) 

mV  cosa 

where  V  is  the  velocity: 

V  -  (a2  +  v2  +  w2) l/2 

The  terms  involving  Fx,  Fy,  Fz  are  the  rates  of  changes  of  flight  path 
angle  which  will  be  much  smaller  that  the  body  angular  rates.  Therefore, 
we  will  neglect  them;  the  resulting  equations  are 


a  ■  q  -  (p  cosa  +  r  sina)  cosa  tand 


(2.11) 


« 

d  ■  -  r  +  (p  cosd  +  q  sind)  tana  cosd. 
The  angles  a  and  6  are  shown  in  figure  2.1. 


(2.12) 


This  figure  suggests  chat  if  the  missile  rolls  while  maintaining  zero 
pitch  and  yaw  rates  (q  «  r  -  U)  the  velocity  vector  rotates  in  the  missile 
frame,  around  the  x-axis,  thus  describing  a  cone.  This  intuition  is  con- 
fimed  by  the  following  calculation.  Setting  q  *  r  *  0  in  (2.11)  and  (2.12) 
we  obtain 


tana 

cos$(t)  -sin$(c) 

cana(0) 

tand 

sin<j>(t)  coso(t) 

tans(0) 

_  — 

M  — 

_  _ 
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Figure  2.1  Definition  of  Angles  for  Monoplanar 

Missile  Configuration  (from  Arrow  (1985)) 
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c 

where  <p(t)  ■  f pdt  is  the  roil  in  time  t. 

0 

The  moments  L,  M,  N  are  assumed  to  be  generated  solely  by  aerodynamic  for¬ 
ces.  Thus  we  will  neglect,  for  example,  thrust  misalignment  effects.  The 
assumed  aerodynamic  moment  equations  are: 

L  ■  Lp  p  +  Ljj  d  +  L0  Op  (2.11; 

M  =*  Mq  q  +  a  +  Mo  ci  q  (2. 14) 

N  =  Nr  r  +  fl  +  N0  ar  (2.15) 

whe  re : 

Lp,  Mq,  Nr  are  the  aerodynamic  damping  coefficients 

L[j ,  Ng  are  angular  acceleration  derivatives  with  respect  to  s 

is  the  pitch  moment  coefficient 

Lo ,  Mo,  No  are  the  control  moment  coefficients 

These  aerodynamic  coefficients  are,  in  general,  complex  functions  of  Macn 
number,  a,  d,  Op,  Oq  and  or.  In  this  paper,  we  will  generally  assume  that 
they  are  known  functions  of  their  arguments  and  that  the  arguments  are 
known. 

In  order  to  simplify  the  following  analysis  we  will  use  the  following 


notat ion 
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d  *  [?  X2lT 
u  -  [p  q  r]T 
u  -  I<Sp  6q  ar]T 
where  x^  »  tan  a,  x2  *  can  3 . 

Then  the  equations  of  motion  may  be  written  in  the  form 


*  Kg  u 

W  ■  Fq  0  +  a)  +  Bu 
whe  re 


i 

0 

0 

-x2 

l+xj^ 

-xi  x2 

X1 

XI  X2 

-d  +  x2) 

0 

Ma 

0 


Lb 

U 

Nrt 


Fuj 


Lp  0  0 

0  Mq  -kp 

0  -kp  Nr 


where 


(2.16) 

(2.17) 


(2.16) 


(2.19) 


(2.20) 


•18- 


Scientific  S  ystems 


r 

rl 

*! 


Sc  e'*'  *  '  SvS’S  S  .  irC. 
P=CP  =  ;£rAa(iv) v 


3.  AUTOPILOT  OBJECTIVES 

The  objectives  of  the  autopilot  are  to  attain  commanded  accelerations 
along  the  body  y  and  z  axes  in  a  minimum  time,  without  violating  a  set  of 
constraints.  This  is  accomplished  via  an  attitude  transfer  maneuver,  sub¬ 
ject  to  certain  constraints: 

(Cl)  the  control  surface  deflections  and  deflection  rates  are  subject 
to  hard  constraints,  due  to  mechanical  limitations 

(C2)  the  angle  of  sideslip  (d)  must  be  kept  suitably  small;  this  is  a 
soft  constraint 

(C3)  body  attitude  rates  are  subject  to  soft  constraints,  dependent  on 
actuator  dynamics  and  control  effectiveness. 


In  addition,  autopilot  design  includes  the  following  requirements:  ■ 

\ 

(i)  provide  dynamic  stability  for  the  airframe  V 

l 

(ii)  body  motion  should  be  minimized 


(iii)  maintain  sufficient  bandwidth  to  respond  to  low-frequency  guidance 
commands  but  not  so  high  as  to  respond  to  high-frequency  noise 

(iv)  avoid  resonance  with  other  missile  components,  including  airframe 
bending  modes,  actuators  and  instruments 

(v)  achieve  time  response  rapid  enough  to  maintain  guidance  loop  sta¬ 
bility  in  the  presence  of  noise  and  errors. 


nn  uivpu  n* 
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These  funccions  must  be  performed  over  a  wide  range  of  altitudes,  Mach 
No.,  dynamic  pressure  and  roll  angles.  In  this  study  we  have  concentrated 
on  the  generic  constraints  (Cl)  -  (C3),  but  have  also  considered  (i),  (ii) 
and  (v).  The  requirements  (iii)  and  (iv)  require  a  specific  missile  con¬ 
figuration,  which  was  beyond  the  scope  of  this  study. 


The  autopilot  maneuver  is  sometimes  divided  into  two  separate  maneuvers: 


1)  A  roll/yaw  maneuver  to  null  the  component  of  commanded  acceleration 
along  the  body  y  axis.  This  places  the  commanded  acceleration  in 
the  body  x  -  z  plane. 

2)  A  pitch  maneuver  to  achieve  the  desired  acceleration. 

The  roll/yaw  maneuver  uses  a  commanded  roll  angle  $c  which  satisfies 

tan  <(>c  ■  (3.1) 

azc 

where  ayC,  azc  are  the  commanded  accelerations.  The  pitch  maneuver  is  per¬ 
formed  to  meet  the  total  commanded  acceleration: 

Za  a  +  Zq  bq  »  (aye  +  azc)^^  (3.2) 

where  Zs,  Z$  are  the  z  axis  acceleration  coefficients. 


Eq  (3.2)  may  be  solved  for  a,  given  ayC,  a2C  and  employing  (2.14)  to  meet 
desired  terminal  conditions  (e.g.,  M“0).  The  division  into  two  separate 
maneuvers  is  often  done  for  simplicity  of  design.  It  is  more  efficient, 
however,  to  combine  maneuvers,  since  this  enables  us  to  attain  the  desired 
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attitude  in  less  time  in  most  cases.  Throughout  this  study  we  have  con¬ 
sidered  combined  maneuvers  only. 


4.  ATTITUDE  MANEUVERS  USING  BODY  RATES  AS  CONTROL 


In  typical  missile  systems  the  actuator  bandwidths  are  much  higher 
than  the  desired  autopilot  bandwidths.  Generally,  autopilot  bandwidtns  are 
5-10  Hz  while  actuator  bandwidths  are  30  Hz  or  more.  Bandwidth  separation 
is  usually  greatest  for  the  roll  channel.  Although  actuator  dynamics  need 
to  be  included  in  detailed  simulations,  we  can  neglect  them  to  do  an 
approximate  analysis.  Total  maneuver  times  may  be  greater  than  one  secona; 
under  these  conditions  the  rate  control  loop  will  be  much  faster  than  the 
attitude  control  loop  so  that  the  actuator  dynamics  can  be  neglected.  With 
this  assumption,  the  vehicle  dynamics  are  given  by  (2.16)  only,  viewing  - 
as  the  control.  The  control  dynamics  are  governed  by  (2.17).  By  using  a 
feedback  law  we  can  easily  achieve  a  stable  rate  loop.  The  feedback 
signals  for  the  rate  loop  are  the  body  rates  measured,  for  example,  by  a 
set  of  strapdown  gyros.  This  design  is  straightforward. 


To  illustrate  a  possible  design  approach,  consider  the  rate  dynamics 
given  by  (2.17)  with  the  control 


u  *  uq  +  G(ujc  -  w) 


(4.1) 


where  mc  is  the  commanded  rate  and  G  is  a  control  gain  matrix  to  be  deter¬ 


mined.  By  defining  du  »  .j  -  jj c ,  with  ujc  assumed  constant,  we  obtain 
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-■"—  (6 u)  ■  Fq  0  +  Fy  o)c  +  Buq  +  (Fy  -  BG)  <5jj 
If  we  set 

-1 

uq  =  -  B  (Fy  a  +  Fy  U)c)  (4.2) 

then 

(6u)  -  (Fy  -  BG)  Oj  (4.3) 

so  that  the  closed  -  loop  rate  controller  dynamics  are  given  by  Fy  -  BG. 
The  rate  loop  may  be  uncoupled  by  setting 

Fy  -  BG  =*  A.jj  (4.4) 

where 

Ay  *  diag  (1/tp,  I / T q ,  L/t r) 

is  the  desired  actuator  dynamic  matrix.  Ay  must  be  selected  to  be  within 
the  bandwidth  allowed  by  the  actual  lags  in  the  actuator  response. 

This  gives,  for  G, 


-23- 


Scientific  Systems 


G  »  B_1  (Fu  -  Au) 


The  control  then  becomes 

u  *  -  B  ^  [Fig  o  +  Fu,  ai  +  (-o)c  -  u>)J  (4.t>) 

which  is  nonlinear  in  both  and  w. 


4.1  Decoupling  Control 


Now  consider  the  problem  of  attaining  a  desired  attitude  o(t[)  =  -c 
at  an  unspecified  terminal  time  tf  starting  from  the  initial  state  -(j) 

at  t»0.  We  can  meet  the  attitude  constraint  by  picking  a  time  history 


such  that 
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Cf  . 

£  0(0  dt 


dc  *  c0 


(4.7) 


Once  we  have  chosen  0(t),  Che  control  is  calculated  as 


-1  . 

ui  •  Kq  0 


(4.8) 


4.1.1  Control  Using  Constant  Rates 

If  we  assume  a  constant  value  of  u  during  the  maneuver  interval, 

i  *  _i_  (  dc  _  o0) 

f 

and  the  resulting  control  is 

1  "I 

UJ  *  — Ktf  (0C  -  d0) 

f 


then 


(4.9) 


(  4 . 1 1 J  ) 


If  we  let  0  -  [ v^ ,  va,  vg]^  then  the  resulting  races  are 


P  *  vq> 


q  *  X2  v*  + 


(I+X2)  va  -  X!  X2  Vjj 


XI  v^  + 


X1  x2  vu  “  (I+X[2)  V3 


where  D  ■  1  +  xi  2  +  x?2. 


(4.11) 


(4.12) 


(4.1 3) 


IV 


5c  e"  •  :  a .  ve— -= 

P°CP  =  E'Aav 
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The  body  rates  will  produce  the  desired  values  p  m  v^,  -r—  (tana)  =  va, 


-r—  (tanS)  -  vg  or,  equivalently,  a  -  v3  /  (1  +  x^),  B  ■  vg  /  (1  +  X22)  . 


Clearly,  for  tf  sufficiently  small,  p,  q,  or  r  will  exceed  the  capability 


of  the  missile,  so  tf  needs  to  be  selected  so  that  none  of  the  body  rate 


constraints  are  violated.  If  we  assume  chat  |  -  p  |  ^  it,  j  tanac  -  tana  | 

<  1,  |  tanSc  -  tano  j  *  e  then  it  follows  that  the  rate  constraints  are  met 


(i)  w  <  tf  Pma) 


(ii)  it  e  +  1  +  2  e2  <  tf  qma, 


(4.U) 


(iii)  «  +  3  e  <  tf  r„ 


Since  pmax  is  generally  larger  than  qmax  or  rmax  and  e  is  generally  less 


than  0.25,  condition  (iii)  dominates,  with  the  result  that  Che  constant  - 


rate  control  can  be  met  if  tf  rmax  >  4.  For  example,  if  rmax  *  2  rad/sec, 


then  tf  >  2  sec  is  required. 


We  can  now  make  a  further  simplifying  assumption,  namely,  that  3  *  0  at 


the  beginning  of  the  maneuver  and  the  commanded  value  is  zero.  With  this 


assumption  X2  *  0,  vg  »  0  and  the  pitch  and  yaw  races  simplify  to 


1  +  xj2 


r  ’  *1  vf 


which  yields,  from  (16),  Xf  »  vlt  or  xj  -  tan  uq  +  v3t.  We  have,  final!; 
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1  +  (tanaQ  +  vat)2 


(4.15) 


r  -  (tana0  +  vat)  v,. 


These  rates  are  well-behaved.  Yaw  rate  r  is  a  linear  function  of  time. 
Pitch  rate  q  is  always  of  the  same  sign.  In  addition  q  obeys  the  differen¬ 
tial  equation 


q  -  -  2  tana  q2 

For  a  BTT  maneuver,  we  would  typically  find  that  tana  >  0  during  the  entire 
maneuver,  so  that  q  would  be  monotonically  decreasing  during  the  maneuver. 


4.1.2  Control  Using  Exponential  Rates 


If  we  set 


U  ■  Ay  (0C  -  0)  (  -♦ .  1  o  J 

where  Ay  -  diag  ( l  / 1  ^ ,  1/t„,  1/Tjj)  then  the  body  rates  (assuming  t  ^  >>  :p, 

T a  »  Tq »  »  Tr)  are 


u)  -  Ky^  Ay  (0C  -  0) 


(4.17) 


and  the  solution  of  (4.11)  is 


0 ( t )  «  e“^Qc  0(0)  +  (I  -  e_AyC)  ac 


( ■» .  i  a ) 


Assuming  0C  -  [<?c,  tanac,  0]  ^  we  obtain 
>c  -  > 


T$ 


(4.19) 


-2  7- 
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q  *  p  tanp  ♦ 


/tano_\ 
yseco  / 


tanac  _  cana 


(4.20) 


/seca  \ 
ytand  J 


r  *  p  tana  + 


tana  tand 


sec*  a  +  tan*  s 


tanac  tana 


(4.21) 


(tanri \ 
seca  J 


In  order  to  achieve  these  conditions,  it  is  necessary  that  the  body 
rate  limits  are  not  exceeded.  By  imposing  these  rate  limits,  we  actually 
set  lower  bounds  on  the  time  constants.  For  example,  since  |  q>c  -  ;  |  <«  '  , 

n 

the  roll  rate  constraint  |  p  |  <  pmax  will  be  met  if  i .  >  - .  Let  us 

Pmax 

assume  chat  during  the  autopilot  maneuver  the  following  constraints  are  met 
|  tana  |  *-  1 
|  tanac  -  tana  |  1 

|  tand  |  <  e 

Then  Che  pitch  rate  constraint  wiLl  be  met  if 


"e  2  , 

x  +  T  ^  ^raax 
t4>  t 

and  the  yaw  rate  constraint  will  be  met  if 


"  .  2e 

—  +  -  <  rn 


/.  .V.V.V/.'  Va’  o  <. 


>  a  'o*  «*'**./  ^  V  V.*  V  v.v.  v.v. 


WMWWWKw  ft  W  nn.n  n.* 


200  deg/sec 


»nt  ml  1  e r 
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z:  6"  ‘  z  o-s’e—i 
E~as  / 


where 


Note  that  ta  and  T3  have  the  same  effect  on  meeting  the  constraints. 

As  an  example,  suppose  pmax  *  200°/sec,  qmax  -  r,^,,  -  100°/sec,  e  *  0.1763 
(d  <  10°).  Then  only  the  pitch  and  yaw  constraints  are  active  and  the 
allowable  region  for  (l/t$,  2/t)  is  shown  in  Figure  4.1.  It  appears  for 
this  case  that  a  good  compromise  solution  is  at  the  upper  right  corner  of 
the  allowable  region  (t*  »  2.17  sec,  t/2  -  0.676  sec). 


A  set  of  less  conservative  conditions  for  determining  whether  the  bud/ 
rate  constraints  are  met  is  to  use  the  closed  -  form  solution  (4.18)  in  tne 
rate  equations  (4.19)  -  (4.21).  if  we  assume  that  dc  is  fixed  and  start 
the  maneuver  at  t  -  0  with  U(0)  given,  then,  assuming  dc  «  0 


-t/Ta 

tan  a(t)  «  e  (tana(0)  -  tanac)  +  tanac 

-t/tjj 

tan  d(t)  -  e  tand(O) 

Substituting  these  into  (4.19)  -  (4.21)  yield  explicit  solutions  for  pit), 
q(t),  r(t),  t>0.  Depending  on  the  initial  conditions  and  commanded  angles 
q(t)  and  r(t)  may  attain  maximum  absolute  values  after  the  start  of  the 
maneuver.  However,  p(t),  q(t),  r(t)  eventually  go  to  zero  exponent lal ,y . 


This  control  concept  is  essentially  equivalent  to  a  predictive 
cont rol le r  in  which  a  specified  output  trajectory  (from  the  current  output 
$,  a,  d  to  the  desired  final  output)  is  followed  as  closely  as  possible, 
subject  to  the  system  and  control  constraints.  Since  the  trajectory  and 


g—i»up»ii»ijnunnm»snm»yuwvwmmy  nnnnwimninjniiwm 

5c  s'"*  *  :  S . 

P=C?  =  :*ipv 
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control  are  known  in  the  future  (for  the  deterministic  case),  it  is 
straightforward  to  pick  the  trajectory  (i.e.  A0)  so  as  to  meet  all  of  the 
constraints.  In  a  more  general  setting,  an  exponential  path  may  not  be 
adequate  for  simultaneous  avoidance  of  constraints  and  minimum-time 
maneuvers  so  that  a  more  complex  path  satisfying  (4.7)  may  need  to  be 
constructed.  In  this  case,  some  ideas  from  robotics  on  minimum-time 
trajectory  planning  under  path  constraints  (see,  e.g.,  Rajan  (1985),  Sahar 
and  Hollerback  (1985),  Sontag  and  Sussman  (1985))  may  be  relevant.  An 
alternate  approach  is  to  limit  the  controls  according  to  the  given 
constraints;  this  yields  piecewise  nonlinear  controls  which  must  be  deter¬ 
mined  using  an  algorithmic  approach  such  as  Model  Algorithmic  Control 
(Rouhani  and  Mehra  (1982)). 

4.1.3  Inclusion  of  Rate  Loop  Dynamics 

The  nonlinear  control  law  of  (4.19)  -  (4.21)  assumes  that  the  desired 
body  rates  are  met  instantaneously  or,  at  least,  that  the  rate  control  loop 
time  constants  are  much  smaller  than  the  autopilot  time  constants.  In  an 
actual  missile  this  may  not  always  be  true.  In  particular,  since  a  rapid 
autopilot  response  is  desired  it  may  be  necessary  to  use  time  constants 
which  approach  those  of  the  rate  loop  dynamics. 

We  assume  a  first-order  lag  model  for  the  rate  loop  dynamics  in  the 

f  orm 

J  “  "a  ( Jc  “  “ )  (->.22) 

(cf  (4.5)),  where  ujc  is  the  input  to  the  rate  loop.  Here,  tor  simpli¬ 
city,  we  will  use  Aa  »  (I'-j)  1.  where  a  u  the  rate  loop  time  constant. 


-31- 
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Sc  e”-  •  :  S.s'er-s  ;r-. 

P  =  CP=  £~ARV 


assumed  Identical  in  all  three  channels. 


Then 


0  d 


(K^uj)  a  +  Kq  Aa  (aic  -  w) 


(4.23) 


Now  we  require  that  the  dynamics  satisfy 


id  +  A  d  +  M  (0  -  yc)  *  0  (4.24) 

where  A  and  M  are  specified  positive  -  definite  matrices  picked  to  yield  tne 
desired  closed-loop  response.  Here,  for  simplicity  we  choose 


A  ■  24u>q  ^ 


(4.25) 


M  ■  wq  I  ( 4  .  _  b ) 

which  yield  identical  damped,  second-order  responses  for  tana  and  tans 
with  frequency  jjq  and  damping  ratio  Substituting  (4.25),  (4.26),  (-*•-.>' 

and  (2.16)  into  (4.24)  yields,  for  the  input  i*)c: 


-1 


Jc  *  Ta  (®c  “ 

+■  [  I  -  2;jJoTa  I  “  Ta  *  1  ^ 


(-*.27) 


where 


-1  3 

v  m  K,^  )  K.j 


(4.28) 


ao 


As  w 


0 


2, 


(-c  -  j) ,  which  is  a  tirst-order  response 


■32- 


4 

i 

* 

3 

j 

3 

j 


U)Q 

equivalent  to  (4.16)  with  Ay  *  ~2^~  I*  As  Ta  ^  “'c* 

The  elements  of  V  are 

<Pl  i  -  <Pi2  m  'V 13  *  0 

V  2 1  *  P  t  -x  i  ]  /  D 

+  q[x^X2  (D  +  1  +  X22)]  /  D 

+  r(l-D  +  X22  (X1X2  +  X|2  -  x22)]  /  D  (4.29) 

* 22  *  Pi _xlx2  ( t>+- 1 )  J  /  D 

+  q[x!  D  +  (1+X!2) ( 1+X22)  xj  j  /  D 

+  r[-D  -  xj2  (I+X1X2)]  X2  /  D  (4.30) 

*23  *  p[l+X22  ( L+D) ]  /  D 
+  q(xiX2  (1+X22)]  /  D 

+  r[l+X22  (l+x1X2)]  xj  /  D  (4.31) 

V3l  -  Plx2l  /  D 

-  q[xj2  (D+X22)]  /  D 

+  r[(xi+X2)  1+xi2)  +  X[  (1-X22)]  X2  /  D  (4.32) 

*32  -  p(-xi2  ( CH- 1 )  -1]  /  D 
+  q[x^2X2  (1+xi2) ]  /  D 

+  r(xix2  (-xi2  ~  xi3  +  x22)]  /  D  (-*.33) 

*33  *  p [ x i x2  (0*D  i  /  D 

+  q[xi  (D  -  xi 2X22) ]  /  D 

+  rl-2D  +  xj2  (l+x^X2)  +  xj^l  X£  /  D  (4.34) 

Two  types  of  physical  constraints  must  be  taken  into  account  here.  Firs 
the  body  rate  constraints  |  p  |  <  pmax,  |  q  |  <  qmax,  |  r  j  <  rraax  must  be  met 
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Second,  the  autopilot  dynamics  will  meet  the  linear  constraint  equation 
(4.22)  only  up  to  a  certain  value  of  ilu>c  -  wU;  beyond  this,  saturation 
effects  will  start  to  occur.  In  order  to  study  the  effects  of  constraints 
more  closely  assume  that  (4.22)  holds  for  |  pc  -  p  |  <  dp,  j  qc  -  q  |  4  dq , 

|  rc  -  r  |  <  dr.  In  addition  we  will  assume,  for  simplicity,  that  X2  =  lj> 
which  is  approximately  true  for  a  BTT  missile.  Then: 

2 

Pc  “  P  ■  “0  Ta  ( $ c  ”  ♦)  ~  2;u)q  rap  (4.35) 

2  2 

qc  -  q  *  (u>q  ta  cos  a)  (tanac  -  tana)  -  2CuiQiaq 

~  Ta  lrP  +  (2q2  -  p2  +  r2)  sina  cosa)  (4.3b) 

2 

rc  -  r  »  (u)q  ta  tana)  ( q>c  -  ?>)  -  r 

+  Ta  [pqsec2a  +  (psina  -  rcosa)  qsina]  (4.37) 

Note  that  the  body  rate  errors  (pc  -  p,  qc  -  q,  rc  -  r)  depend  linear Lv  on 
Now  we  make  the  following  reasonable  assumptions  which  should  be  always  me 
in  practice:  |  <pc  —  <p  |  <  tt  ,0<a<  45°,  0  <  ac  <  45°.  Then  the  desired 
response  of  (4.24)  is  guaranteed  if  the  following  three  conditions  are 
simultaneously  satisfied: 

(1)  "wq2  +  2ro)Q  pmax  <  dp  /  Ta  (4.3b) 

(ii)  u>02  +  2Cu>0  qmax  +  ( Pmax  +  rmax)2  1  2  (4.39) 

+  ‘Imax2  ^  ^q  /  Ta 
2 

(Hi)  +  2^0  rmax  *  2*5  Pmax  9raax  (4.4j) 

+  0*5  9max  rmax  ^  ^r  /  Ta 

These  equations  can  be  used  in  autopilot  system  design  to  set  upper  limit-, 
on  wq  and  Q ,  given  specified  values  of  tne  rate  loop  dynamic  limits  (dp,  d 


dr) ,  rate  loop  time  constant  (ta)  and  body  rate  limits  (pmax,  qmax,  rmax). 
As  a  numerical  example,  a  typical  missile  might  have  the  following  para¬ 
meter  values:  dp  -  dq  -  dr  -  10  rad/sec,  Ta  =*  0.10  sec,  pmax  =  5  rad/sec, 
qmax  =  r^x  -  2  rad/sec.  In  addition,  assume  a  damping  ratio  of  0.50. 

Then  we  get  the  following  conditions: 

(i)  ttu)q2  +  5  u)q  <  100 

(ii)  +  2  wq  <  71.5 

(iii)  ttidq2  +  2o)q  <  73 

condition  (iii)  dominates,  giving  wq  <  4.51  rad/sec 

4.1.4  Stability  Analysis 

The  decoupling  control  of  (4.8)  always  exists,  since  is  nonsingular. 

Thus  as  long  as  y  is  finite,  w  is  finite.  If  the  constraints  are  not 

violated,  then  the  desired  path  {0(t)  te  (0,  te)}  satisfying  (4.7)  will  oe 
followed  with  no  error  in  the  deterministic  case.  This  is  one  advantage  of 
the  decoupling  control  concept  and  the  use  of  a  desired  reference  path. 

If,  however,  the  state  0  is  not  perfectly  known,  the  control  will  be  in 


error  and  an  instability  in  closed  loop  may  result.  In  order  to  study  this 
possibility,  define  the  state  error  as 
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where  0  is  the  state  estimate  used  by  the  controller.  Consider  the  expo¬ 
nential  rate  case  (4.16).  The  resulting  control  is 


-1  - 

<*>  -  Ke  (9)  Ae  (0C  -  0) 

Then,  to  first-order,  the  closed-loop  dynamics  are 


(4.42) 


9  ■  [  1  +  Ke(0)  E^b,  e)]  A0  (0C  -  0  -  e) 

where 


(4.43) 


3  -1 

3  'I 

E K(0,  e)  =* 

3X1  *  (0) 

el  + 

Sx2  ^  (rf> 

_ 

_  _ 

and  et  -  Xl  -  X1 ,  e2  =*  x2  -  x2.  The  roll  error  e^  does  noC  appear  since  K,., 
is  independent  of  <f> .  The  closed-loop  stability  now  depends  on  the  behavior 
of  the  time-varying  matrix 

M(0,  e)  *  Kq(9)  Eg(0,  e)  (4.43) 

If  all  eigenvalues  of  I+M  (0,e)  are  in  the  right  half  plane,  then  stabi¬ 
lity  is  assured,  in  the  sense  that  any  deviations  from  the  desired  path 
will  tend  to  decay  to  zero  exponentially  in  the  absence  of  future  distur¬ 
bances  or  errors.  The  driving  term  -Aue  can  cause  an  offset.  If  e  is  a 

constant  then  at  steady-state  («  *  0),  o  *  uc  -  e. 


If  we  write  M(0,e)  in  the  form 


P  =  CP3:E_ARv 
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M(0,  e)  *  Mj(0)ei  +  M2(0)e2 


(4.46) 


Mj(0)  -  -x^X2 


x^(2  +  X2  ) 
D 


X2( 1  -  xt  ) 


(4.47) 


-( I+X22) 


x2(  1  +  x2  ) 
D 


M2(ti)  »  l+X]/ 


2 

xi  x2 
D 


xi( 1  +  xi  ) 


(4.48) 


xl<t  ~  x2  ) 

D 


X2(2  +  xi  ) 


In  order  to  analyze  Che  stability  of  (4.43),  assume  Ay  =»  1/T  I,  Then 


one  stable  pole  is  at  s  «  -1/T,  corresponding  to  the  roll  channel.  The 


other  two  poles  are  stable  if  the  following  two  conditions  are  simulta¬ 


neously  met: 


(i)  eTx  <  I  +  xT> 


(4.49) 


(ii)  (e^x2  -  e2X[)2  +  2eTx  <  I  +  xTx 


(4.50) 


where  eT  *  (ej  e2) ,  xT  =  (x^  X2). 


These  conditions  can  be  given  a  geometrical  interpretation  by  viewing 


and  x  as  vectors  in  (note  that  they  have  orthogonal  components  spa- 
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daily).  If  oe  is  the  angle  between  e  and  x  then  we  have  equivalent 
conditions: 


(i)  tel  Ixl  cos  0e  <  1  +  llxi2 
(ii)  He!2  ilxl2  sin20e  +  2  He!  Ixl  cosoe  <  1  +  ilxt2 


(4.51) 

(4.52) 


where  lell2  ■  e^e,  etc.  The  most  conservative  bound  on  He!  for  stability 
may  be  found  by  maximizing  the  left  hand  sides  of  (4.51)  and  (4.52)  with 
respect  to  0e.  We  find  that  0e  =  0  maximizes  in  either  case  and  that 
(4.52)  dominates  yielding 


llell  < 


1  +  llxll 
2  llxl 


(4.53) 


The  right  hand  side  of  (4.53)  is  bounded  below  by  1.  Thus,  the  final 
result  is  that  stability  is  guaranteed  if  He!  <  1.  This  is  equivalent  to 
saying  that  the  sum  of  the  squared  errors  in  angle-of -attack  and  angle  cf- 
sideslip  estimates  must  be  less  than  1  rad2,  a  condition  which  should 
always  be  met  in  practice.  Recall,  however,  that  (4.33)  is  the  result  of  a 
linearized  analysis  and  holds  only  for  He!  sufficiently  small. 


The  overall  conclusion  is  that  the  decoupling  control  law  (4.42) 
appears  to  be  extremely  robust  for  the  dynamical  model  of  (2.16).  Now  we 
consider  the  stability  of  the  controller  of  section  4.1.3,  which  included 
the  rate  loop  dynamics.  In  this  case  (4.22)  holds  but  the  commanded  rate 
of  (4.27)  becomes 
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il>  Vi  Hi  jit  * 


r,  i  .  y-  .  t  i ,  >• ,  «  - 


»  *  4  r  3 

P°CP=;  E'A3  ✓ 


u»c  -  U)02  Ta  K^l(y )(0C  -  y) 


+  [  I  -  2;u0  Ta  I  -  Tav(0)]  <4 


(4.54) 


Inserting  (4.54)  into  (4.23)  and  keep  only  the  first-order  error  terms 
yields , 

•*  t 

y  +  L  2Cw0I  +  MQ  +  Eg  +  QKy  MKy  J  d 

+  uq2  (i  +  m)  (y  -  yc) 


(  —  I  -  2;uiqI-Q)  K^e^j  -  OJ0* 
a 


(4.35) 


where 


(Kqui) 


0  2x^q-X2r  -p-x^r 

0  P+X2q  X[q-2x2r 


_  «q  ao 

eQ  ■  777  el  +  7$;  e2 


0  2qej  -  re 2  -re; 


0  qe2 


qe  j  -  2re2 


(4.56) 


(4.37) 


C"  »  *  *  •  •  *■  *  9  »  • 

'  ■  V  . 
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M  has  been  defined  in  (4.45),  and  ew  *  u>  -  j.  The  race  estimation 
error  ew  could  be  caused  by  rate  gyro  errors,  for  example.  We  find  that 
the  attitude  dynamics  are  driven  by  both  the  attitude  error  e  and  the  rate 
error  e^.  Further,  the  stability  of  the  attitude  maneuver  now  depends  on 
the  body  rates  as  well  as  attitude.  However,  it  is  interesting  to  note 
that  the  matrix  Q,  which  contains  the  body  rates,  appears  only  multiplied 
by  M  in  the  dynamics.  Thus  if  races  are  small,  the  system  is  more  stable. 
It  is  also  interesting  that  the  rate  error  e^  does  not  effect  stability 
properties;  it  affects  only  the  magnitude  of  the  offset  from  the  desired 
path  linearly. 

••  • 

The  steady-state  attitude  error  is  found  by  setting  d  *  a  »  0  in 
(4.55),  yielding 

a  -  3C  ■  -~T~  <  T~  I-2^oI-Q)Koeu;  -  (I-M)e  (4.38) 

'■J0Z  Ta 

where  we  have  assumed  M  <  <  I,  or  (l+M)-^  *  I-M.  The  effect  of  rate  error 
e^  decreases  as  uiq  increases  and  as  Ta  increases.  In  normal  operation, 
body  rate  errors  will  probably  have  a  smaller  effect  on  attitude  offset 
than  attitude  error,  since  body  rates  will  be  measured  by  relatively 
accurate  rate  gyros. 

The  analysis  of  stability  of  (4.55)  becomes  complex  algebraically  and 
difficult  to  interpret.  We  can,  however,  study  a  special  case  in  decail. 
Assume  chat  Hail  <  <  1  and  define 

e  -  qei  -  re2  (4.59) 

If  we  write  (4.55)  in  the  form 
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fc)  +  iig  o  +  Wg  d  *  d 
Chen  the  characteristic  equation 


(.-t.O'j) 


si  -I 

We  sI+Ae 

factors  to  the  form 


0 


(s^  +  2Cu>qs+u)q)  (s^  +  aj  s-^  +  ais^  +  aj  s  +  sq)  *  0 
where 

a3  *  4<^ujo  +  3e 

2 

a2  ■  2(2CjJq  +  e)  ( <; -oq  +•  e)  +  2u>q 

«1  *  w0  2  a3 
4 

a0  -  '->0 

It  follows  chat  (4.55)  is  stable  if  ;  >  0,  which  is  true  by  design,  an: 
if 


qe i  -  re2  +  Cwq  >0  (4.bl) 

so  that  stability  is  enhanced  by  increasing  ;  and  j(),  so  long  as  our  nooe  . 
(4.55)  remains  valid.  Note  that  high  body  rates  will  tend  to  destabilize 
the  closed-loop  system,  although  this  depends  on  the  signs  of  the  body 
rates  and  the  errors  in  estimates  of  a  and  tJ.  This  result  suggests  that 
one  could  enhance  stabilization  at  high  body  rates  by  biasing  the  estin.it- 
of  a  and  d  so  as  to  keep  the  Left  hand  side  of  4.bl  positive. 
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4.2  Control  Accounting  for  Race  Constraints  Directly 

In  practice,  the  attainable  body  rates  will  in  many  cases  be  the 
limiting  factor  in  quickly  attaining  the  desired  attitude.  Here  we  discuss 
a  simple  suboptimal  control  strategy  which  explicitly  takes  the  body  rate 
constraints  into  account.  We  will  assume  that  |  p  j  *  pmax,  |  9  |  *  qmax, 

|  r  |  <  rmax  an<^  consider  the  same  attitude  transfer  problem  as  before.  A  ke 
consideration  in  control  design  is  how  to  keep  A  sufficiently  small 
throughout  the  maneuver.  If  a  time-optimal  control  problem  is  set  up, 
using  constraints  on  d,  the  resulting  optimality  conditions  are  quite 
complex,  since  they  involve  state  constraints  (see,  e.g.  Maurer,  197-*)  and 
a  two-point  boundary-value  problem  must  be  solved  on-line.  We  can  elimi¬ 
nate  this  complexity  by  assuming  that  a  -  0  throughout  the  attitude 
transfer  maneuver.  This  assumption  will  be  approximately  true  in  most 
cases.  With  this  assumption,  the  dynamics  become 

x^  »  (1  +  X[2)  q  (4.t»l) 

r  *  x^  p  (d  -  0)  (i.b 2) 

The  minimum  -  time  pitch  maneuver  is 

q  *  qmax  sgn(cic  -  ag) 

which  yields  tana(t)  ■  tan  (og  +  qt)  and  a  transfer  time  tf  *  |  ac  -  ag  |  /qra 
The  roll/yaw  maneuver  involves  checking  the  constraints  at  each  time  point, 
since  xi  changes  with  time.  At  each  time  point  during  the  maneuver  either 
Che  roil  constraint  or  the  yaw  constraint  (or  both)  will  be  active.  The 
resulting  rates  are 


P3Cc=  E'aav 


p  -  sgn($c  -  $)  min  (pmax,  rmax  /  1x^1) 
r  -  sgn(xj  p)  min  (rmax,  j  xj  )  pmax) 

Roll  race  p  is  set  to  zero  when  $  reaches  $c; 
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(4.63) 

(4.64) 

pitch  rate  q  is  set  to 


zero  when  a  reaches  a c.  These  will  generally  occur  at  different  times. 
Inspection  of  this  maneuver  suggests  that  further  improvement  may  be 
possible  in  cases  where  large  roll  maneuvers  but  only  small  pitch  maneuvers 
are  required.  In  this  case,  allowable  roLL  rate  magnitudes  can  be 
increased  if  a  is  first  decreased  in  magnitude  and  then  subsequently 
increased  in  magnitude  to  its  final  value.  This  can  be  seen  more  expli¬ 


a 


citly  by  formulating  an  appropriate  mini mum- time  control  problem. 


a 


4.2.1  \  Minimum-Time  Control  Law 

Consider  the  dynaraicaL  system  comprised  of  (4.61)  and  $  =»  r  /  X(,  i.e., 
3  =>  0.  If  we  view  q  and  r  as  controls  the  variational  Hamiltonian  for 
the  minimum-time  problem  is  (e.g.,  Athans  and  Falb,  1966): 

H  *  1  +  q  (1  +  xj2)  +■  *2  r/xj  (4. 65) 

The  minimizing  controls  are 

* 

H*  =  -  9max  (*l>  (4.66) 

*  * 

r*  *  -  r^x  sgn  (W^i)  (-*.67) 

*  * 

where  the  optimal  costates  and  ■satisfy  the  EuLer-Lagrange  equativis 


-4  3- 


(i.'xj) 


m  m 

*1*  >  -  2  q*  xj*  Aj*  +  r*  ^2  /  X{*2  ,  Aj(tf)  ■  cj 


x2*  *  o  ;  ^(tf)  “  c2 


where  sgn(.)  is  +  i  for  a  postive  argument,  -l  for  a  negative  argument  aid 
otherwise,  and  c^,  c2  are  constants  to  be  determined  to  meet  the  required 
terminal  conditions  and  to  satisfy  H(t)  »  0  for  all  t.  The  t ime-mi n imi z i 
path  is  characterized  by  pitch  angle  and  angle-of-attack  i*.  We  wi , L 
assume  at  the  moment  that  a*(t)  >  0  along  the  optimal  path.  Then 


q>*(t)  ■  i  (r*  /  xj)  dt  t(j 


a*(t) 


^  q*  dt  >  20 


with  q>*(tf)  -  <*c,  a*(tf)  -  ac  and  xq*  *  tan  a*(t).  If  we  integrate  back¬ 
ward  along  the  optimal  path,  assuming  q*  and  r*  are  constant,  we  find 


q>*(c)  -  9C 


sina( t) 


^l(t) 


c2  |  rmax  cot  a*(t)  -  L 


2  * 

cos  a  (t) 


f  '  1) 


We  can  now  characterize  the  solution  of  the  minimum-time  problem.  Since  - 
assume  that  a*(t)  >  0  for  t  e  (0,  tt),  r*  is  constant  tor  t  c  (o,  tt). 
However,  q*  may  change  sign.  However  q*  can  only  switch  from  -  z> 

+  qmax,  not  vice  versa.  Thus,  if  time  permits,  a*  is  first  reduced  to 
Increase  roll  rate,  and  then  is  increased  to  its  final  value. 


It1 


We  have  assumed  here  Chat  the  optimal  path  does  not  violate  the 
constraint  a*(t)  >  0,  but  the  constraint  was  not  explicitly  included  in  the 
problem  formulation.  If  a*(t)  becomes  too  small  the  roll  rate  constraint 
will  oe  violated.  The  constraint  |  p  |  <  paax  can  be  included  via  the  state 
constraint  a  >  amin  where 

amia  -  tanl(  *;■*«  )  (4.73) 

"max 

The  optimal  paths  may  contain  ir  :s  along  the  constraint  boundary,  depending 
on  the  constraint  vaLues  and  desired  terminal  state.  If  the  state  is  on 
the  constraint  boundary,  it  comes  off  it  the  time  which  allows  the  terminal 
ang le-of -at tack  constraint  to  met. 

4.2.2  Inc  lu  s  Ion  if  Ro  L_L_  kata  Co  ns  t  r  a  i  n  t 

If  we  incLude  the  roll  rate  constraint]  r'<i  |  <  pmax  explicitly,  cue 
problem  formulation  changes.  W'-ltiig  the  coustraiit  is  s(<[,  r)  <>  j,  wh-  '■ 

->  =j  r'tr  |  -  padX,  Hamiltnnian  becomes  (Bryson  &  Ho,  1  973): 

H  *  1  +  nq  (  l  +  x [ - )  r/x[  +  o  s  (-4.7-.; 

where  a  >  d  for  s  »  0  (on  the  constraint  boundary)  nl  u  >  )  tor  i  ;  i 
the  biundur-y).  )'f  tie  ooundary,  the  optimality  :  ndlt  i  ;ns  are  the  same  is 


before.  On  the  boundary  ve  have 
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P  *  ~  Pmax  =«5:1  -2-)  N.i:,) 


Integrating  (4.67)  backward  from  terminal  time  tf  using  constant  q* 
gives,  on  the  boundary 


* 

^  1  (t) 


C1 


cos^a*( t ) 


cos-a 

c 


(•*.«  3) 


where  ac  *  a*  (tr-) . 


Two  examples  of  minimum  time  maneuvers  are  shown  in  Figures  4.2  and 
4.3.  In  each  case,  the  maximum  roll  rate  was  4  rad/sec,  the  maximum  pitcn 
and  yaw  rates  were  1.0  rad/sec  and  the  final  desired  angie-of-attack  was  _ 
degrees.  The  desired  roll  maneuver  was  90  degrees.  In  the  first  case 
Initial  angle-of-attack  was  assumed  to  be  zero,  which  yielded  an  initial, 
boundary  arc  (p  -  4  rad/sec),  followed  by  a  control-constrained  path 
(r  *  1  rad/sec)  starting  at  tgo  *  0.196  sec.  The  (minimum)  elapsed  time 
was  0.445  sec.  The  pitch  rate  was  l  rad/sec,  starting  at  tgo  *  0.436  so.- 
(the  possibility  of  switching  the  sign  of  q  over  the  initial  0.009  second 
was  neglected  in  view  of  physical  lags  in  a  real  system) . 
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In  the  second  example,  the  initial  angle-of-attack  was  25  degrees;  tr.e 
remaining  parameters  were  unchanged.  In  this  case,  the  minimum  -  time  pa: 
includes  two  arcs  off  the  boundary  and  an  interior  boundary  arc  for  tne 
roll  channel.  The  pitch  channel  includes  a  pitch-down  maneuver  (q  =  -. 
rad/sec)  for  the  first  half  and  a  pitchup  maneuver  (q  *  1)  for  the  seco.oc 
half.  The  reduction  in  angle-of-attack  allowed  tne  roll  rate  to  be 
increased  to  its  maximum  possibLe  value,  thus  reducing  transfer  time. 
Elapsed  maneuver  time  was  J.*98  sec.  Noce  chat  a  maneuver  made  without 
reducing  angle-of -at tck  would  require  0.7  33  sec. 


3 
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Time  Optimal  Control  -  Sample 


Tine  Optimal  Control  -  Example 


5.  FULL  DECOUPLING  CONTROL 


Our  objective  is  to  control  the  components  of  0  independently. 
Introducing  the  output  y  =  0,  our  objective  is  to  attain  the  commanded  out¬ 
put  y(tf)  =  y^  at  the  unspecified  final  time  tf.  In  addition,  we  wish  to 
achieve  the  condition 

y(t)  =  0;  t  >  tt-  (5.1) 

i.e.,  the  angles  <p ,  a,  3  are  held  constant  from  the  end  of  the  present 
maneuver  until  the  beginning  of  the  next  maneuver.  From  (2.16): 

y  =  u>  (5.2) 

so  that  (5.1)  is  satisfied  if  oj(t)  =  0;  t  >  tf.  From  (2.17),  this  requires 

-1 

u(t)  =>  -  B  Fy  0;  t  >  tf 

Prior  to  the  terminal  time  tf,  we  can  develop  a  decoupling  controller  as 
follows . 

In  order  to  introduce  the  control  u,  we  need  to  cake  another  derivative  of 
y  which  yields 

y  =  Fy  0  +  u»  +  Bu  (5.3) 

whe  re 

F0  =  ICj  Fj  (5.4) 
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(5.5) 

(5.6) 


It  is  clear  that  we  can  control  y  explicitly  via  u  if  B  is  non¬ 
singular.  The  determinant  of  B  is 

j  B  |  *  -  |  B  |  (1  +  tan^  a  +  tan^  6)  (5.7) 

- I  B  |  D 

Thus,  we  can  decouple  the  control  problem  if  )  B  |  *  0.  From  (2.21) 

|  B)  *  0  only  if  one  or  more  of  the  control  derivatives  is  zero,  that  is, 
if  one  or  more  of  the  body  axis  torques  is  not  controllable  through  control 
surface  deflections.  The  conclusion  is  that  a  nonlinear  decoupling  ton:r;. 
exists  if  the  missile  is  physically  controllable,  a  condition  which  must  be 
met  for  any  steering  law.  The  condition  of  physical  controllability  is 
equivalent  to  the  condition  that  non-zero  torques  can  be  applied  indepen¬ 
dently  to  all  three  axes,  which  will  hold  if  the  missile  is  not  in  a  stalls 
flight  condition  and  actuator  torque  limits  are  not  exceeded. 


Now  suppose  we  wish  to  achieve 

y(c)  -  g(t)  ( 5 . H) 

From  (5.3),  we  find  that  the  decoupling  control  is 

u-i-l  [g  -  Fy  t)  -  F(jJ  oj  (5.9) 

Substituting  (5.9)  into  (2.16)  and  (2.17)  gives  the  dynamics  of  the  closej- 
loop  system  under  decoupling  control: 
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•*  t  *  a  «■■>  i>  -.y  . 


tS  i*e.  »V*  *>,,  4 


c°-  ■  :  i,s:e.~5.  i-c. 
paQpa.c-Apv 


a  ■  K<3)  m 


(5.10) 


•  •  1  “ 

m  ■  K<3  g  -  Ky 


l  a_ 

dd 


(K<-j  iii)  K^i  -u 


(  5  .  L  1 ) 


„-l 

g  -  V  ■•*> 


where  the  elements  of  4*  are  given  in  (4.29)  -  (4.34) 


This  controller  is  closely  related  to  the  linear  -  equivalent  control 


methodology  (see,  e.g.  ,  Su  (  1982),  Meyer,  et  al  (1984)),  in  which  a  non! 


near  dynamical  system  is  converted  into  a  linear  system  via  nonlinear 


transformations.  If  we  define 


x^t)  -  /  Ky(a(T))ul(T)  di 


*2(t)  ■  K(j(3(t)  )w(t) 


or,  equivalently,  x^  *  3,  x£  *  o ,  then  the  dynamics  are  in  the  linear, 


time-invariant  canonical  form 


0  I  v 


where 


v  *  [Bu  +  u  +  F,j 


+  —  (K^>  ^ 


g(t)  ( cf ( 5 . 8) ) 


and  the  actual  control  u  can  be  round  as  a  runction  of  cne  linear  -  ec 


lent  control  v  and  the  states  xj,  x?  via  known  meraoryless  nonlinear  trc 


c 


4.*  |.f  *  ’ 


.«*  ,*u  . 
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formations.  This  is  essentially  the  result  of  Su  (1982)  applied  to  the 
missile  autopilot  problem.  Reed,  et  al  (1985)  obtained  essentially  the 
same  result  and  then  solved  a  quadratic  optimal  control  problem.  Dwyer 
( 1984)  used  the  same  approach  to  solve  large  -  angle  rigid  body  rotational 
maneuver  problems.  Although  these  approaches  lead  to  attractive  dynamical 
models,  the  problem  of  control  under  constraints  is  not  resolved.  In 
essence,  the  nonlinearities  are  pushed  into  the  control  and  it  is  not  at 
all  clear  how  (actual)  constraints  on  u  map  into  constraints  on  v.  Thus, 
while  these  methods  simplify  the  dynamics,  they  tend  to  preserve  complexity 
in  control  constrained  problems.  However,  there  is  an  apparent  advantage 
to  these  approaches,  namely,  that  the  complexity  now  resides  in  a  single 
expression,  relating  the  original  and  linear  -  equivalent  controls  via  a 
nonlinear,  memoryless  transformation.  Another  potential  disadvantage  is 
that  any  state  constraints  have  to  be  nonlinearly  transformed  to  be  ade¬ 
quately  handled. 


5.1  A  Decoupling  Controller  With  Exponential  Response 


We  can  use  the  results  so  far  to  design  a  decoupling  controller  to  give 
a  desired  response  characteristic.  For  example,  suppose  we  wish  to  obtain 
a  response  with  the  following  dynamics 


u+Au+W(a-  y_)  »  o 


where 


M  diag  2*ju>ct,  2^^^^) 


2  2  2 

W  -  diag  (utj,,  ala,  ui3) 


(5.12) 


(5.13) 
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with  <;a,  4g  the  desired  damping  ratios  for  the  roil,  pitch  and  yaw 


channels,  respectively  and  w*,  wa,  uig  the  desired  frequencies.  The  solu¬ 


tion  of  (5.12)  is  a  set  of  uncoupled  damped  second-order  systems  of  the 


U(0)  coswt  + 


£w4>(0)  +  »(Q) 


sinut ] 


(5.15) 


oi  *  u)  v  1  -  ^2 


which  has  poles  at  -  *  j  u>. 


g(t)  -  -  At>  -  W(0  -  0C) 


and  the  decoupling  control  satisfies 


Kj  B  u  «  W  -  (W  +  l(j  Ft))  a  -  [a  +  Kq  Fu  K^1  +  -tr  OCeoi)]  Kyui  (5.16) 


In  order  to  interpret  this  control  law,  we  write  out  the  control  components 


explicitly,  assuming  dc  »  0: 


1  r  2 


( <t> c  —  <j> )  —  Ljj  tana  -  (2;^,  ^  +  Lp)  p] 


(3.17) 


.  1  r  2  2  .  .  - 

Aq  *  - —  Lu)0  cos  a  (tanac  -  tana)  -  Mq  tana 

M6 


-  (kp  -  (p  +  r  tana)  cos  a)  (p  tana  -  r) 


-  (2;a  oia  +  Mq  +  2q  tana)  q] 


(5.18) 
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12  2  - 
o r  -  — —  [u,$  tana  ($c  -  j> )  +  (wjj  -  NB)  tand  -  (2;$  +  Nr)  p  tana 

Nd 

+  (k  +  sec2a)  p  q  +  ( 2C ^  wg  +  Nr  +  qtana)  (P  tana  “  r)]  (5.19) 

In  order  to  Insure  that  the  amplitude  and  rate  constraints  on  Op,  6q  and  or 
are  met,  simulations  using  actual  numerical  values  of  the  stability  deriva¬ 
tives  are  required. 

In  order  to  analyze  this  case  further  we  will  assume  that  3*0.  Then 
p  tana  *  r  and  we  have: 


t-o  (9c  —  9)  —  (2^^w^  +  I-p)  P 


2  2 

(Da  cos  a  (tanac 


-  tana)  -  Mq  tana 


-  (2;au)a  +  Mq  +  2q  tana)  q 


N0  <5r  -  wj  tana  (9C  -  9)  -  (2C$w$+Sr)  p  tana 
2 

+(k+seca)pq 


where  all  terms  are  torques  in  rad/sec^. 


We  can  derive  a  set  of  sufficient  conditions  for  full  application  of 
decoupling  control  under  constraints  with  several  assumptions.  Assume  the 
following  constraints: 
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(i)  controi  deflections 

|  Sp  |  <  ^pmax*  |  I  ^  ^qmax»  I  I  ^  °rmax 

(ii)  control  effectiveness 

|  f-d  |  >  f'dmin*  |  ^0  |  ^  ^6min*  |  ^6  |  ^  ^Omin 

(iii)  rate  damping 

|  Lp  |  <  Lpmax>  |  Mq  |  <  Mqmax,  |  Nr  |  <  ^rmax 

(iv)  moment  coefficients 

|  |  ^  ^amax 

(v)  body  rates 

I  P  I  ^  Pmax»  |  *1  I  ^  Qraax*  |  r  I  ^  rmax 

(vi)  attitude 

|  $c  “  f  |  <  71 »  |  tanac  -  tana  )  <1  ,  i  »  0, 

0  <  a  <  it/4 

This  leads  to  Che  following  sufficient  conditions  for  full  decoupling 
control: 

n  +  ^max  ,  -  £>ptuax-“ ^  ^omin  *pmax 

(b)  m2  +  ^cinjaX  +  qmax  ®ax( ,  -  Mqmax  -  2;au)^)  <  M3m^n  ^qmax 

(c)  +  ( k  +  2)  pmax  ^max  +  Pmax  tnax  -  Nr  -  ^ i uj ) 

$ 

^  min  ^rmax 


EF<i>  *  ?u> 

(5.21) 

eF0  *  “*  Ftf 

(5.22) 

RK  -  (Ky  -  Ky)  Ky 1 

(5.23) 

RB  *  (B  -  B)  B_1 

(5.24) 

Then,  analagous,  to  (5.12)  we  can  write  the  closed-loop  dynamics  as 

w  +  Ae  a  +  we  y  *  d  (5.25) 

where 


Ae  »  A  +  Ky  Epw  Ky1  +  (A+Q)  R&  +  Eq  ~  Rr(A+Q) 

-  Ky  RB  [Ky1  (A+Q)  +  F^Ky  * )  (5.26) 

We  >  W  +  Ky  Epy  -  R*W  -  Ky  RB  (Fy  +  Ky  ^  W) 


(5.27) 
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d  -  (i  -  Ke  rb  k^  -  Rr)  w0c  "  <w  +  Fe>  e 

-  [Ke  F^  +  (A  +  Q)  Kj  e^, 


(5.28) 


Note  that  Che  matrix  Q,  which  is  linear  in  the  body  races  q  and  r,  can 
have  a  significant  effect  on  stability  for  high  rates.  Note  that  R^  and  Rg 
are  composed  of  terms  which  are  essentially  error  ratios,  and  thus  are  less 
chan  one  in  magnitude  for  moderate  percentage  errors.  Also,  the  elements 


-1 


of  and  are  less  than  one  in  magnitude,  except  for  the  (1,1)  elements 
which  are  equal  to  one.  We  can  qualitatively  conclude  that  this  controller 
appears  robust  to  estimation  errors,  and  that  the  most  critical  error  terms 
are  those  involving  Q  in  Ae.  Note  also  that  stability  should  be  enchanced 
by  increasing  c  and  wq  up  to  a  point,  since  this  increases  the  positive- 
definitiness  of  Ae  and  jj6.  If  the  values  of  wq  and  C  are  too  low,  then  the 
error  terms  are  likely  to  dominate  the  dynamics,  leading  to  instability. 
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